#include <SPI.h>
#include <nRF24L01.h>
#include <RF24.h>
#include <RF24_config.h>
#include "printf.h"
#include <Servo.h>

RF24 rf(7, 8);
Servo s[5];

void setup(void)
{
  Serial.begin(9600);
  printf_begin();
  
  for (int i = 0; i < 5; i++) {
    s[i].attach(i+2);
  }

  rf.begin();
  rf.setRetries(15,15);
  rf.setPayloadSize(8);
  rf.setChannel(124);
  rf.setDataRate(RF24_250KBPS);
  rf.openReadingPipe(1, 0xB16B00B500LL);
  rf.startListening();
  rf.printDetails();

}

void loop(void)
{
  if (rf.available())
  {
    int payload[6];
    rf.read(&payload, sizeof(payload));
    for (int i = 0; i < 5; i++) {
      s[i].write(payload[i]);
    }
    printf("%4d,%4d,%4d,%4d,%4d,%4d\n", payload[0], payload[1], payload[2], payload[3], payload[4], payload[5]);
  }
}
  
